MAY 2 8 2004 „, 



0 



106 — 



102 



Hybrid model 
descr ipt ion 



101- 



Variable and mechanism 
element correspondence 
data 



109 



Control 
s i gna I 

~r~ 



105 



Variable and 

mechanism 

element 

correspondence 
table 



Dynamics simulation 
unit 



—107 



104 

1 

Three-dimensional 
mechanism model 



Kinematics simulation 
unit 



-103 



FIG. 1 



106 — 



108 



Variable and mechanism 
element correspondence 
data - 



Mechanism control software 
system or its simulator 



102 



Hybrid model 
descr ipt ion 



101 



109 

1 



Control 
signal 

~T~ 



105 



Variable and 
mechanism 
e I ement 

correspondence 
table 



Dynamics simulation 
unit 



107 



104 



Three-dimensional 
mechanism model 



Kinematics simulation 
unit 



-103 



FIG.2 



( Start ) 



Load hybrid model 



] — 501 



Load three-dimensional 
mechanism model 



Receive control signal 



Dynamics simulation 



Check correspondences of 
variables and transmit values 
to kinematics simulator 



502 

503 
504 

— 505 



Kinematics simulation I — 506 

-507 



Transmit data to mechanism 
control system 




Advance time by one step | — 509 C End j 

FIG.3 




303 

F=mx 



FIG. 5 



301— 



303 -F=mx 




Valve 

left 
>~ 



Valve 
r ight 



301— 






*ir; 






3 1 ' 



303 F=mx 



FIG. 6 



< 



L2 
L3 
L4 
L5 
L6 
L7 
V L8 



#def ine 
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always if ILeftl t hen do always lF=m * x" I w atching Right, 
always if iRightl then do always FF=m* x"l watching Left, 
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cont a, b; 

cont s i n (cont x) ; 

a=0; 
b=0; 

always { 
b' =0.2; 
a' =sin (b) ; 

} 

samp I e (a) ; 
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class DCML_Class 
{ 

pub I i c cont m_a ; 
DCML_Class(cont a) { 

m_a = a; 

m_a' = 0. 01 ; 

} 

def { 
do { 

always m_a"+(1/4) * m_a' +0. 03 * m_a = 1/2; 
} watch i ng (m_a' = 0) ; 



} 



when(m_a' - 0) always {m_a* = 0; } 



} 

DCML_Class app1 (1) ; 
sample(app1. m_a) ; 
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cont time; 
time = 0; 

always {time' = 1 ;} 
class Motor 



80 




paper, pos 



motor"!. vaL 



60 80 



{ 



Motor (cont init_val, cont acc_end, cont end) { 
val_ =init_val; 
acc_end_ =acc_end; 
end =end ; 

} 

pub I ic event go_; 
private cont end_, acc_end_; 
public cont val_, start_time_; 
def { 

always {end_' = 0;acc_end_' = 0;start_time_' =0;} 
do {a I ways va I _' = 0 ; } watch i ng (go J ; 
when(goJstart_time_ = time; 
when (go J a I ways { 

do {always vai_' =4;} watching (time=start_time_+acc_end_) ; 
when (t i me=sta r t_t i me_+acc_end_) 

do {always val_' =0;} watching (time=start_time_+endj 
when (time = start_time_+endjalways val_ = 0; 

1 



} 



} 



class Paper 



{ 



}; 



pub I ic cont val_, pos_; 
def { 

pos_ =0; 
always pos_' = val * 0.075; 



always paper. val_ = motor1.val_; 
when (t i me = 10) motor 1 . go_ ; 
when (t i me = 70) motor 1 . go_ ; 

Paper paper; 

Motor motorl (5. 0, 10. , 25. ) ; 

sample (motorl. val _J ; 
sample (paper. pos_) ; 
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